





Topics Covered 


Multiplicative Extended Kalman Filter (MEKF) for MMS 
On-board Attitude and Rate Determination 


• MEKF formulation (points-of-interest) 

• Measurement Model (star sensor) 

• Flight Performance 


MEKF for Identification of System Properties 

( center-of-mass , moments of inertia , and thrust) 

• State Augmentation 

• Measurement Model (accelerometer) 

• Thruster Warm-Up Model 

• Simulated Test-Case Performance 

• Simulated Monte Carlo Performance 

• Flight Performance 


25th ISSFD, Munich, Germany 


25 October 2015 


Brief MEKF Review 

Multiplicative Extended Kalman Filter 

• Extended Kalman Filter (EKF) variant 

• 1st flight use SPARS (1969) 

• rigorous formation by Lefferts, Markley, and Shuster (1982) 

• continued refinement and advocacy by Markley (2003) 



EKF with Additive Update 

qtrue = Aq + q 

/ \ 

error quaternion full (global) 

state used in filter state estimate 


MEKF Multiplicative Update 

qtme = <5q®q 

X \ 

error quaternion full (global) 

not directly used in filter state estimate 
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MEKF Error State Idiosyncrasies 


The MEKF uses a reduced three component attitude 
parameterization as the error-state inside the filter. 

• Could use any three-component attitude representation (e.g. Euler rotation axis/ 

angle, Gibbs vector, Modified Rodrigues parameters, Tait-Bryan angles, etc.) 

• MMS chose (twice) the Gibbs vector parameterization: 

► free of singularities up to ±i8o° 

► largest possible i8o° map to infinity (compatible with Gaussian “tails”) 

► avoids accumulation of numerical errors in full-state quaternion norm through explicit 
normalization in reset operation that is neither ad hoc or require transcendental evaluations 

► observation model insensitive to sign ambiguity in star camera’s output quaternion 

► diagonals of error covariance matrix (P) map directly to attitude error variance (a 2 ) 
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State Dynamics 


On-board MEKF Models 



Measurement Updates 

zero due to reset op 
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Even though Hj< is not used here (due to reset op) it is needed for 
covariance propagation. NOTE: partial derivatives are with respect to 
y states (but result only differs for non-additive states). 
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Star Sensor 


pASC Star Tracker System (STS) provided 
by the Technical University of Denmark 
(DTU) 

• Four camera head units (CHUs) 

• Redundant centralized electronics 

• 4 Hz update rate 

• Measurements combined as a pre-processing 
step in to single measurement update for 
computationally simpler on-board MEKF 
processing 

• Spec performance levels (4 heads combined): 


Image from MMS-3, CHU-B 
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Transverse 
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Measurement Model 
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On-orbit Performance 


Examining the performance of the MEKF rate estimation for the first two 
thruster-pulses of a calibration maneuver (EA019) executed on 1 April 2015. 


Spin Rate Estimate 



Transverse Angular Rate Estimate 



Telemetered Spin Rate Estimate 
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Full Calibration Maneuver 


Full EA019 maneuver rate profile 

• exercises all twelve thrusters individually, in matched pulse-pairs, 1/2 nutation cycle apart 

• thrusters #1 (radial) and #12 (axial) exercised in double pairs to characterize warm-up 


ACS FSW AD (Principal Axis) Angular Rate Estimates 
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EA019 STS Measurement Residuals 


CHU-A 


CHU-B 


p = 15.76 a = 14.56^) 120^ = 9,82 a = 20.47 
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Camera Head 
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Measurement 
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Flight Telemetry 


Augmented MEKF for 
Ground-based System Identification 


Case for System ID State Augmentation 

MMS maneuvering performance requires accurate knowledge of 

• (Fuel) Inertia Tensor — lacking gyroscopes, the second mass moment of inertia knowledge directly 
affects the accuracy of the rate estimate. Angular rate errors (along with center-of-mass knowledge) 
affect the centripetal compensation algorithms used in closed-loop orbital maneuvers. Since the dry 
system properties were well known prior to launch , only the fuel's contribution to inertia is estimated. 

® (Fuel) Center-of-Mass — knowledge of the lever-arm from the CM to the accelerometer sensor heads 
affects the ability to remove gyro-dynamic biases from the incremental velocity output of the AMS. 

© Steady-State Thrust — closed-loop incremental velocity feedback removes the majority of the 

maneuvering system's sensitivity to knowledge errors in thruster. However, in order to achieve 1% (3 a) 
maneuvering accuracy, it was shown via Monte Carlo simulations that 3% (3a) steady-state thrust 
knowledge was necessary due to the corruption of rate-propagation with an incorrect torque (gyro 
rate-substitution would alleviate). 

© Warm-up Knock-down Factor — warm-up effects of the cat-bed in the hydrazine thruster's thrust- 
chamber can degrade initial thrust by as much as 13%. In order to account for this in the system 
dynamics, a simplified thermal-model of the thruster was added to the MEKF. Two thermal-states per 
thruster are required. Thermal coefficients of the model were determined from pre-flight test data. 

© Accelerometer Intrinsic Biases — in order to use the accelerometer measures for thrust-determination, 
the intrinsic thermo-electrical biases of the AMS sensor heads must also be estimated. 
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Acceleration Measurement System 


Acceleration Measurement System 
(AMS), manufactured by ZIN 
Technologies 

• three orthogonal Honeywell QA3000 
accelerometers 

• 1 00 kHz analog-to-digital sampling 

• dynamic range of greater than ±25,000 pg 

• resolution of less than 1 pg 

• short-term (la) bias stability over a twelve 
hour period of better than 1 pg 

• effective bandwidth of 250 Hz 



• 1 KHz (down-sampled) acceleration integrated 
(corrected and summed) to produce an 
incremental velocity-change output at 4 Hz 

• low-pass bias estimation filter 
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Accelerometer Measurement Model 


Modeled as a proof-mass connected to a rigid-body by tri-axial 
springs, the device acceleration relative to a body-fixed origin is 

a d = = b A. (v o - a gra v) + u x r d + u> x u> x r d 

Introducing the base-body’s center-of mass (r c ) yields a truth 
model 

ad= m + ( r< * ~ r c) +u x u x (r d - r c ) - (2 • u; x r c + r c ) 

r cd multi-body effects 


where ft is the acceleration due to body-fixed thrusters. 


Acceleration measurement model assumes n uni-axial 

measurements (along u n ) corrupted by bias, noise and scale factor 
errors 
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Augmented Measurement Models 


STS measurement sensitivity matrix 

(H c hu)k = [^3 03 X 3 03 X 3 03 x 3 03 x 3 03 x 3 03 x 3 03 x 3 

AMS measurement sensitivity matrix 
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thruster 1 steady-state 
force estimate [N] 



System ID: 2-Pulse Test-Case 


Introduced knowledge errors into a 
simulated test-case system 

• pair of pulses from thruster #1 at 20 and 36 secs 


Parameter 

Error 

accelerometer biases 

+20 ng 

fuel center-of-mass 

+50 mm 

fuel moments of inertia 

+10 kg-m 2 

steady-state thrust magnitude 

+5% 


Steady-State Force Estimation Test-Case Results 
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Composite Center-of-Mass Estimation Test-Case Results 
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Composite Inertia Tensor 
Estimation Test-Case Results 



System ID: 2-Pulse Test-Case 
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System ID: 2-Pulse Test-Case 


AMS Bias Estimation Test-Case Results 
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System ID: Monte Carlo Results 


Hundreds of parameters in the high-fidelity simulation of the MMS spacecraft 
were randomly perturbed within the expected distributions and (conservative) 
uncertainty limits of ground-based knowledge. 

The full EA019 maneuver was simulated and statistics collected on the accuracy 
of the augmented MEKF system identification process. The results from 300 runs 
are shown. 


Steady-State Thrust Estimation Monte Carlo Statistics 
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Moments of Inertia Center of Mass 



System ID: Monte Carlo Results 


Composite Mass Property Estimation Monte Carlo Statistics 
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System ID: MMS1 EA019 Flight Results 


Ground processing of the EA019 maneuver for MMS1 
produced the following results: 


Lateral Center-of-Mass Estimation Axial Center-of-Mass Estimation 
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System ID: MMS1 EA019 Flight Results 
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System ID: MMS1 EA019 Flight Results 

Comparison of pre-flight and post-calibration system 

identification for observatory MMS1 


State 

Units 

Pre-Cal 

Post-Cal 

Difference 

CM-x 

mm 

-0.14 

3.31 

3.45 


CM-y 

mm 

0.13 

4.72 

4.59 

— 

CM-z 

mm 

605.28 

604.56 

-0.72 


Ixx 

kg-m 2 

991.50 

968.10 

-23.40 

(-2.4%) 

lyy 

kg-m 2 

996.25 

936.54 

-59.71 

(-6.0%) 

Izz 

kg-m 2 

1614.93 

1598.41 

-16.52 

(-1.0%) 

Ixy 

kg-m 2 

-107.49 

-82.88 

24.61 

(-22.9%) 

Ixz 

kg-m 2 

-0.01 

-0.18 

-0.17 

— 

lyz 

kg-m 2 

-0.07 

-0.30 

-0.23 

— 


Thruster 

Units 

Pre-Cal 

Post-Cal 

Difference 

01 

N 

17.06 

18.38 

1.32 

7.73% 

02 

N 

17.06 

18.20 

1.14 

6.66% 

03 

N 

17.06 

18.26 

1.20 

7.04% 

04 

N 

17.06 

18.24 

1.18 

6.90% 

05 

N 

17.06 

18.64 

1.58 

9.25% 

06 

N 

17.06 

18.74 

1.68 

9.85% 

07 

N 

17.06 

18.49 

1.43 

8.35% 

08 

N 

17.06 

18.34 

1.28 

7.51% 

09 

N 

4.27 

3.94 

-0.33 

-7.67% 

10 

N 

4.27 

4.03 

-0.23 

-5.46% 

11 

N 

4.27 

3.82 

-0.44 

-10.34% 

12 

N 

4.27 

3.97 

-0.30 

-6.94% 
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Additional Flight Validation 
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Summary 

• Implementation details with regards to the MEKF formulation were 
discussed 

• The MMS on-board attitude and rate estimation MEKF was documented, 
and flight results presented 

• An augmented state MEKF for ground-based estimation of thruster 
output, center-of-mass, moments-of-inertia, and accelerometer biases 
was developed 

• a simple two-pulse test-case results were shown 

• Monte Carlo performance statistics were presented for a full calibration of the 
twelve MMS thrusters 

• Flight system identification results from the MMS EA019 calibration maneuver were 
shown and compared to pre-flight system knowledge 
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Thank you for your attention. 


Many thanks to our conference 
organizers for a wonderful event. 


Any questions? 


